#include "tracing.h"
#include "motor.h"
#include "oled.h"

void tracingInit(){
	GPIO_InitTypeDef  GPIO_InitStruct;
	
	RCC_APB2PeriphClockCmd(READ_GPIO_CLK, ENABLE);
	
	GPIO_InitStruct.GPIO_Pin = O_GPIO_PIN | T_GPIO_PIN | TH_GPIO_PIN | F_GPIO_PIN | FI_GPIO_PIN | R1_PIN | R2_PIN;
	GPIO_InitStruct.GPIO_Mode = GPIO_Mode_IN_FLOATING;
	GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
	GPIO_Init(READ_GPIO_PORT, &GPIO_InitStruct);	
}

uint8_t tracingSpot(){
	if(R_2 == 0 || R_3 == 0 || R_4 == 0){
		delay_ms(2);
		if(R_2 == 0 || R_3 == 0 || R_4 == 0 )
			return 1;
	}
	else{
		return 0;
	}
}

